/*
*******************************************************************************
* Copyright (c) 2021 by M5Stack
*                  Equipped with M5Core2 sample source code
*                          配套  M5Core2 示例源代码
* Visit the website for more information: https://docs.m5stack.com/en/module/plus
* 获取更多资料请访问: https://docs.m5stack.com/zh_CN/module/plus
*
* describe: PLUS.
* date: 2021/9/2
*******************************************************************************
  This exmpale can display the encoder gear reading of the PLUS Module and the state of the keys.
  本例可以显示PLUS模块的编码器齿轮读数和按键状态。
*/
#include <Arduino.h>
#include <M5Core2.h>

#define IrPin 33  //--------------------------------------------------------------------
#define PLUS_ADDR 0x62

int32_t number = 0;
uint8_t press = 0;


void setup() {
    M5.begin(true,true,true,false,kMBusModeOutput);
/*   kMBusModeOutput,powered by USB or Battery
  kMBusModeInput,powered by outside input need to fill in this Otherwise M5Core2 will not work properly
  由外部供电时此项必填,否则M5Core2将无法正常工作 */

    M5.Lcd.setTextFont(6);
    M5.Lcd.clear(BLACK);
    M5.Lcd.setTextColor(ORANGE, BLACK);
    Wire1.begin(21,22);
    ledcSetup(1, 38000, 10);
    ledcAttachPin(IrPin, 1);
}

void plus_encode() {
    Wire1.requestFrom(PLUS_ADDR, 2);
    while(Wire1.available()) {
        int8_t encode = Wire1.read();
        uint8_t press_n = Wire1.read();
        number += encode;
        if(press_n == 0xff) {
            press = 0;
        }
        else {
            press = 1;
        }
    }
}

void loop() {
    char data[20];

    plus_encode();
    ledcWrite(1, ledcRead(1) ? 0 : 512);
    sprintf(data, "%d  %d        ", number, press);
    M5.Lcd.setCursor(100, 100);
    M5.Lcd.print(data);
    vTaskDelay(200);
}
